NONLINEAR OBSERVERS FOR GYRO CALIBRATION COUPLED WITH A 
NONLINEAR CONTROL ALGORITHM 


Julie Thienel* and Robert M. Sanner* 

Nonlinear observers for gyro calibration are presented. The first observer esti- 
mates a constant gyro bias. The second observer estimates scale factor errors. 
The third observer estimates the gyro alignment for three orthogonal gyros. The 
observers are then combined. The convergence properties of all three observers, 
and the combined observers, axe discussed. Additionally, all three observers axe 
coupled with a nonlinear control algorithm. The stability of each of the resulting 
closed loop systems is analyzed. Simulated test results are presented for each 
system. 


INTRODUCTION 

Gyroscopes, also known as Inertial Reference Units (IRU) or gyros, are part of the attitude control 
system of most three-axis stabilized spacecraft. They measure the spacecraft angular rate. Unfortu- 
nately, the gyro measurements are corrupted by errors in alignment, scale factor, and bias, as well as 
random noise. 1 Several algorithms for estimating the errors, as well as the noise characteristics, are 
available. 2-8 Most algorithms rely on linear techniques and are not coupled directly with the spacecraft 
control. 

The published nonlinear methods tend to follow a similar Lyapunov development to determine 
stability, most are driven by a measurable attitude error. Alonso, et al. in Ref. 9 develop a nonlinear 
observer for relative attitude and rate estimation with an application to spacecraft formation flying. 
Salcudean in Ref. 10 develops a nonlinear observer for angular rate estimation. Both observers are 
driven by a computed attitude error. However, in order to estimate the rate, both observers require 
knowledge or estimation of spacecraft torques. The stability of the observer developed by Salcudean 
requires an assumption that the system eventually behaves as a linear time invariant system. In Ref. 
11, Vik, et al. develop an angular velocity observer, in addition to a position and velocity observer, 
for use in a Global Positioning System (GPS) /Inertial Navigation System (INS). The angular velocity 
observer is actually a nonlinear observer for gyro calibration. The observer is designed to estimate 
corrections to the gyro measurements, particularly misalignment and scale factor corrections, along 
with gyro biases. The misalignment and scale factor errors are assumed to be small. All the error 
terms are modelled as exponentially decaying, first-order equations. The Lyapunov analysis proves 
that the observer, given the above assumptions, is exponentially stable. A closed-loop analysis of the 
observer, coupled with a controller, is not presented. Nonlinear observers for gyro bias estimation are 
presented by Boskovic, et al. in Refs. 12 and 13. In Ref. 12, the bias is assumed to be constant, 
which differs from the exponentially decaying model of Ref. 11. However, the bias is assumed to lie 
in a small, bounded set. Second order terms are neglected in the observer development and in the 
Lyapunov proof of stability. The observer is coupled with a controller which is designed to drive the 
spacecraft rates to zero and the spacecraft body coordinates to the inertial coordinates. With the 
second order terms neglected, the closed loop system is stable for the single scenario presented. In Ref. 
13, the gyro bias observer is designed for use in attitude tracking. Here the bias observer is driven by 
a computed attitude error, as in Refs. 9, 10, and 11. However, the attitude error is computed as a 
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vector difference, rather than a rotational error, without consideration to the normality constraint of 
the attitude. An adaptive tracking controller is coupled to the observer. The convergence proof for 
this observer assumes that the vehicle attitude never passes through ±180 degrees, and the stability 
of the coupled observer/controller/spacecraft dynamics is not formally established. 

As the above discussion indicates, combined observer-controller designs for the attitude control of 
rigid flight vehicles are a subject of active research . 11-13 Successful design of such architectures is 
complicated by the fact that there is, in general, no separation principle for nonlinear systems. In 
contrast to linear systems, ‘certainty equivalence’ substitution of the states from an exponentially con- 
verging observer into a nominally stabilizing, state feedback control law does not necessarily guarantee 
stable closed-loop operation for the coupled systems . 14,15 In this work, one version of this problem is 
considered, the task of forcing the attitude of a rigid vehicle to asymptotically track a (time- varying) 
reference attitude using feedback from rate sensors with persistent nonzero errors. 

The next section introduces the terminology used throughout the document, as well as an overview 
of a nonlinear attitude control law. Next, the development of nonlinear observers for the case of 
constant gyro bias, constant scale factor error, and constant alignment error are presented. Each 
observer is combined with the nonlinear control scheme for attitude control of a spacecraft. Simulation 
results are presented for each of the observers and for each of the closed loop systems. The paper 
concludes with a summary and discussion of future work. 


TERMINOLOGY 


The attitude of a spacecraft can be r 
unit rotation vector e, known as the Euler axis, and a rotation about this axis so that 16 


represented by a quaternion consisting of a rotation an^le and 


-^l<N 

1 


£ 

L cos (f) J 


. V . 
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where q is the quaternion, partitioned into a vector part, e, and a scalar part, 77 . Typically, in spacecraft 
attitude applications, the quaternion represents the rotation from an inertial coordinate system to the 
spacecraft body coordinate system. Note that ||q|j = 1 by definition. The rotation matrix for a specific 
attitude can be computed from the quaternion components as R(q) = {rj 2 — £ T e)l J r2££ T — 2r)S(e) where 
I is a 3x3 identity matrix and S(e) is a matrix representation of the vector cross product operation . 16 


S(e) = 


0 

e z 


0 ~£ x 
St 0 


The rotation matrix is orthogonal, R T R = I. Note also that R{q)e = e . 

The relative orientation between two coordinate frames is computed as 17 


Qi ® <? 2 = 


772 / -S(e 2 ) -e 2 
e\ 772 



* Si 


. . 


(2) 


where q defines the rotation from the frame defined by q% to the frame defined by q\. Note that 
||e|| = 0 , 77 = ±1 indicates that the frame 2 is aligned with frame 1 . 


The kinematic equation for the quaternion is given as 


q(t) = 


m 

v(t) 


^Q(q(t))cj(i) = I 


V(t)l + S(e(t)) 

-e(t) 



Q i(?( 0 ) 

~e(t) T 




(3) 


where u>(t) is the spacecraft angular velocity in body coordinates and where, by inspection, Qi(q(t)) = 
rj(t)l + S(e(t)). The angular velocity, u >(t), is typically measured by a gyro, which can be corrupted 
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from various sources, such as errors in bias, misalignment and scale factor, and noise. The measured 
angular velocity can be written as 1 

u) g (t) = YR T {q g )uj{t) + b g {t) + v ug (t) (4) 

where u> g (t) is the angular velocity in the gyro coordinate frame, T is a diagonal matrix of scale 
factors, or more traditionally, a matrix containing scale factor errors (i.e. the main diagonal contains 
components 1 4- 7*, where 7 \ is the scale factor error for gyro i). This work considers only the case of 
three, orthogonal gyros. Therefore, R(q g ) is an orthogonal gyro alignment matrix, a transformation 
from a gyro coordinate frame to the spacecraft body frame (note that for a non-orthogonal gyro triad, 
this matrix cannot be represented with a quaternion). The (possibly time varying) gyro bias is given 
by b g (t), in the gyro coordinate frame, and finally, v ug {t) is a zero mean noise vector, also in the gyro 
coordinate frame. 

Solving (4) for u;(£), 

u>(t) = C{uj g {t) - bg(t) - u ug (t)) (5) 

where C = (TR(q g ) T )~ 1 = R(q g ) r -1 for three orthogonal gyros. Rewriting (5) as 

w(f) = Coj g (t) - b(t) - u(t) (6) 

where b(t) = Cb g (t ) is the effective gyro bias in the spacecraft body frame, and similarly, v(t) is the 
effective noise in the spacecraft body frame. If I\ q g , and b(t) are known, an unbiased estimate of u;(t) 
is 

u;(t) — Cu g (t) — b(t) 

This paper considers the case where F, q g , and b(i) are unknown and of arbitrary size. 

In this work, the gyro alignment, scale factors, and bias are assumed to be constant. In other words 

q g (t) = 0, t i(t) = 0, b(t) = 0 

The effects of uniformly bounded noise on the bias and angular velocity are considered in Ref. 18. 

If 6(t), q g (t), and Ti(t) are estimates of the unknown bias, alignment quaternion, and inverted 
scale factor matrix, respectively, an estimate of the angular velocity is given as 

&(t) = R(q g (t))ri(t)u> g (t) - b(t) (7) 

For the case of bias error only (assuming the alignment and scale factor matrices are known), (7) 

u>(t) = R(q g )T~ 1 ujg(t) — b(t) (8) 

The equation is rewritten accordingly for a pure alignment estimate (with known scale factor and zero 
bias), as 

u(t) = R(g s (t))r _1 u> 9 (t) (9) 

where R(q g (t)) represents the rotation from gyro coordinates to an estimated body frame. Finally, for 
an estimate of the inverted scale factor matrix (7) (with a known alignment and zero bias) becomes 

£>{t) = R(q g )fi{t)u> g {t) (10) 

or similarly for any other combination of terms. 

The error terms for each of the calibration parameters are defined as 

b(t) = b- b(t), q g (t) = q g ® 7 /(*) = 7/ - 7 /(<) (U) 

where 7 j(t) is a scale factor error vector defined as the difference between the inverted true scale factors 
and the estimates. This work examines each error source separately. 
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Nonlinear Control Algorithm 


The attitude dynamics for a rigid spacecraft are given as 

Hv{t) - = u(t) (12) 

H is a constant, symmetric inertia matrix and u(t) is the applied external torque, for example, from 
attached rocket thrusters. The goal of the control law is to force the actual, measured attitude q(t) 
to asymptotically track a (generally) time- varying desired attitude q d (t) and angular velocity u > d (t), 
related for consistency by (3) as qd(t) = ^Q(q d (t))u>d(t) It is assumed that t j d (t) is bounded and 
differentiable with c j d (t) also bounded. 

The commanded attitude tracking error is computed with (2) as 

Qc{t)= (13) 

Correspondingly, the rate tracking error is 

u c (t) = U>(t) - R(q c (t))u> d (t ) (14) 

With these definitions, the tracking error obeys the kinematic differential equation 17 

Qc(t) = ~ Q{q c {t))u> c (t ) 

A nonlinear tracking control strategy proposed by Egeiana and Goahavn in Ref. 19 utilizes the 
control law 

u(t) = -K D s(t) + Ha r (t) - S(Hu>(t))u r (t) (15) 

K d is any symmetric, positive definite matrix and s(t) is an error defined as 

s(t) - Cb c {t)t 4- A i c (t) = a ;(£) - w r (t) (16) 

where A is any positive constant. The reference angular velocity u> r (t) is computed as 

Vr(t) = R(q c (t))ujd(t) - A i c (t) (17) 

and 

ot r (t) = d>r(t) = R(q c (t))w d (t) - S(u c (t))R(q c (t))uj d (t) - \Qi(q c (t))u> c (t)t (18) 

Asymptotically perfect tracking, i.e. i c (t) — ► 0, cl? c (t) — > 0, is obtained with the above control scheme, 
given noise free measurements of the states cj(t) and q(t). In this work we investigate the application 
of this control algorithm, given the uncertainties in the angular velocity as quantified above. 

NONLINEAR OBSERVERS 

Following the observer proposed in Ref. 11, a state observer for the attitude in the case of either 
gyro bias or scale factor error is proposed as 

4(0 = ^Q(q(t))R{q 0 {t)) T [u{t) + ki 0 (t)sign{fj 0 {t))} ( 19 ) 

where u(t) is given in (8) for the case of gyro bias and in (10) for the case of scale factor error. 

The proposed observers for the gyro bias and scale factor errors are 
Gyro bias: 

*>= -^o{t)sign{fj 0 {t)) ( 20 ) 
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Scale factor: 


4 /<(*) = |w ffi (<)£ oi (t)sign(7? o (0) ( 21 ) 

In the case of alignment error, the proposed attitude observer contains an additional term. The 
attitude and alignment observers are given as 

k(t) = \Q(4(t))R(qo(t)) T [u>(t) + k(t)i 0 (t)siga(()fj 0 (t)) + fc 1 (t)sign(e 0 (t))sign(^ 0 (t))] (22) 

k a (t) = IqW, («))[(/ - fl(4foW)mWKW] (23) 

where &(t) is as given in (9). The scalar gains k > 0, k(t) > 0, and k\(t) > 0 are defined below. 

For the gyro bias observer, the alignment and scale factor are assumed to be known. The same is 
true for the scale factor and alignment observers (the other components are assumed to be known). 

The quaternion, q(t), is a prediction of the attitude at time t, propagated with the kinematic 
equation using the measured angular velocity and the current estimate of the error source, either gyro 
bias, scale factor, or alignment estimate. The attitude error is the relative orientation between the 
predicted attitude provided by (19) or (22) and the true attitude provided by the measured attitude, 
q(t). The attitude error is computed using (2) as 

qo(t)= [ ] =q(t)®q(t 0 )- 1 (24) 

In (19) and (22) the term R{q 0 {t)) T transforms the angular velocity terms from the body frame to the 
observer frame. 

In the scale factor observer (21), £<*(£) are the three elements of The estimated scale factor 

components, Jn{t) with i = x,y,z , are estimates of the inverse of the true scale factor components. 
Only scale factor estimates corresponding to non-zero w gi (t) are included in (21). The components 
7 u(t) form the main diagonal of the matrix Tj(t) in (10). Note that the estimated scale factors, 7 /*(£), 
are never inverted in the observer (or in the controller to follow) so dividing by zero is not a possibility. 

In the alignment observer (23), the quaternion, q g (t), is the estimated gyro alignment quaternion, 
transforming from gyro coordinates to an estimated body frame. The alignment error is given in (11). 

In the case of pure bias error, the kinematic equation for q 0 (t) is given as 

ho{t) = 1 (-b(t) - ki 0 (t)sign(fj 0 (t)) (25) 

where b(t) obeys the differential equation 

h) = 7 }£o(t)sign(fj 0 (t)) (26) 

Note that the equilibrium states for (25) and (26) are 

[ q 0 (t) T b{t) T ] = [o 0 0 ±1 0 0 0] 

Ref. 18 proves that for any measured angular velocity, w 5 (t), the equilibrium states of the system (25) 
and (26) are exponentially stable. In particular, b(t) — > b exponentially fast from any initial conditions 
q(to) and b(t 0 ). Additionally, Ref. 18 considers the effect of bounded noise on both the bias and 
angular velocity. Again, the observers are found to be exponentially stable to within a ball determined 
by the standard deviations of the noise terms. 
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For pure scale factor errors, the derivatives of the attitude error, q Q (t), and the scale factor error 
components are 

4.(0 = \ [ Q lf°$ (T _1 «,(0 - r/(*K(t) - ki 0 (t) S \gn(Ut)) (27) 

*fn(t) = -7jV gi (t)£ 0 i(t)sign(Ti 0 (t)) (28) 

where again, i — x, y, z. F~ l is a diagonal matrix, containing the inverse of each of the true scale factors, 
defined as 7/*, on the main diagonal. The scale factor errors are defined as 77* (t) = 77* — 77 *(t), with 
tj(t) given as 

" 7 ix{t) 0 0 

Ti(t) = 0 7 /yW 0 

0 0 . 

The difference in angular velocity terms in (27) is then 

T l UJg(t) — f j(t)uig(t) = T I (t)ujg(t) ~ Flg(t)~fl{t) 

where £l g (t) is a diagonal matrix with the components of u> g (t) on the main diagonal and 77 (t) is a 
vector containing the components (27) is rewritten as 

4.(0 = | ( fi </(07/(0 - ^o(0sign(()^o(0) (29) 

Note that the equilibrium states for (28) and (29) are 

[ <Zo(0 r 7/(0 t ] = [ 0 0 0 ±1 0 0 0 ] 

In the case of alignment error, the kinematic equation for the attitude error quaternion is 

4.(0 =1 [ ] (*farK(0 - R(q g (t))u g (t) - k(t)i 0 (t)sign(fj 0 (t)) 

- fci(*)sign(e 0 (t))sign(»j 0 (t))) (30) 

Since the true alignment is constant, the angular velocity associated with the kinematic equation for 
the true alignment quaternion is zero. The kinematic equation for the alignment error quaternion is 
therefore 

4,(0 = \ [ Q 4% ( )r } ] mm) - i)R(q a {t))"M (3i) 

Since R(q g ) = R(q g (t))R(q g (t)), where R(q g (t)) represents the rotation from the estimated body frame 
to the actual body frame, (30) becomes 

4.(0 =\ ] P(4,(0) - W<? 3 (0W0 - k(t)i 0 {t)sign(fj 0 (t)) 

- ki (t)sign(e 0 (t))sign(7y 0 (t))] (32) 

Note that the equilibrium state for each of the error quaternions, q 0 (t) in (32) and q g (t) in (31), is the 
identity quaternion, [0 0 0 ± 1]. 

For combined scale factor and bias errors, the kinematic equation for the attitude error quaternion 
is 

4.(0 = \ [ (r _1 w s (0 - 6(0 - r/(0^(0 + 6(0 - *e„(0sfen(<7o(0) 

= i ( fi ff(*)7/(0 - 6(0 - ke o (t)sign(rj 0 (t))) (33) 
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For combined alignment and bias errors, the kinematic equation for the attitude error quaternion is 


Qo(t) = \ 




{R(q g )u g (t) - b(t) - R(q g (t))oj g (t) + b{t) 


- k(t)i o (t)sign(fj 0 (t)) - fc 1 (0sign(e o (<))sign(^ o (t))) 


Qi{Qo(t)) 

-eo{t) T 


(R(q g {t)) - I )R(q g (t))u> g (t) - b(t) 


- k(t)i o (t)sign(ij 0 {t)) - fci(i)sign(e 0 (i))sign(?7 0 (i))) 


(34) 


Finally, for combined alignment, scale factor, and bias errors, the attitude error quaternion kinematic 
equation is 


ko(t) = - 


Q i(9o(t)) 

-io(ty 


(R(q g {t)) - I)JR(g ff (t))fi 9 (t)7/ - - &(*) 


k(t)i 0 {t)sign(fj 0 (t)) - fci(t)sign(e 0 (t))sign(?7 0 (t))) 


(35) 


Stability of Scale Factor Observer 


The proof follows that of the gyro bias observer. 18 Choose a Lyapunov function as 


^(*)=|s>‘W 2+ ! 


i=i 


(fjo(t) - l) 2 + i 0 (t) T i 0 (t) 
( fjo(t ) + l) 2 + e 0 (t) T e 0 (t) 


Vo{t) > 0 

fjo(t) < 0 


(36) 


V a [t) is continuous. Noting that £ 0 (l) T e 0 (t) + fj 0 (t)T} 0 (i ) = 0, as with the gyro bias analysis, the 
derivative of V a (t) (including the left and right derivatives of fj 0 (t) = 0) yields, for all t > to 


Vo{t) = -\i 0 {t) T e 0 {t) (37) 

This establishes that £ 0 (t), Vo(t )> and 7 are globally, uniformly bounded. V a {i) is a continuous, 
twice differentiable function with V Q (t ) bounded, given that oJ 9 (t) is bounded. Barbalat’s lemma 15 
then shows that H^oOOII — > 0 as t — > 00. 


If u> 9 (t) is bounded, all the signals in (28) and (29) are bounded. The system is, as in the gyro bias 
case, analyzed as a linear time varying system, x(t) — A(t)x(t). 14 If all the components of u> 9 (t) are 
nonzero, A{t) is given as 


A(t) = 


~^sign(fj 0 (t))Qi(q 0 (t)) ^Qi{q 0 (t))^ g (t) 

— isign(ri o (t))0 s (t) 0 


If any of the components of u> 9 (t) are zero, the system is reduced in dimension according to the non-zero 
components of u; p (t). 


The development proceeds like that for the gyro bias in Ref. 18, under the assumption that 
w 5 (t) is at least bounded. The equilibrium point x(t) = 0 of the equivalent system is exponentially 
stable if the pair (A(t),C) is uniformly completely observable (UCO). Rewriting V Q (t) as V Q (t) = 
~x(t) T C T Cx(t) < 0, C is defined as C = y/|l 0 j . Equivalent to the gyro bias observer, the UCO 

property is examined with output feedback, resulting in a persistency of excitation condition. If the 
following is true for a bounded u> 9 (t) and any z in R 3 

ft+T 2 

z T [J VL g {r) 2 ]z> 0 (38) 

the system is UCO, and both e 0 (t) and 7 j(t) converge to zero exponentially fast. In other words, each 
component of c o g (t) must be nonzero for some nontrivial interval over an interval of length TV (38) 
establishes the persistency of excitation (PE) condition for the scale factor observer. 


7 



Stability of Combined Scale Factor and Bias Observers 


The Lyapunov function is the same as that given in (36), with the addition of ±b(t) T b(t). V Q (t) is 
the same as (37), establishing that the errors signals b(t) and ji(t) are globally, uniformly bounded. 
V Q (t) is a continuous, twice differentiable function with V Q (t) bounded, given that u g (t) is bounded. 
Barbalat’s lemma 15 shows that ||e 0 (t)|| 0 as t —> oo. 

If uj g (t) is bounded, all the signals are bounded. As with the scale factor observer above, the system 
is analyzed as a linear time varying system x(t) = A(t)x(t). u Here A(£) is given as 


A(*) = 


2 sign(77o(^))Ql (<?o (^)) %Ql(qo(t)) 2 Ql(Qo(t))£lg(t) 

±sign(f) 0 (t)) 0 0 

-±sign(fj 0 (t))n g (t) 0 0 


and C — [ 0 0 


j. If the following is true for a bounded u* g (t) and for any z in M 3 


z 


T 



I n,(r) 

V 3 (t) 


dr\z > 0 


(39) 


the system is UCO, and both e G (t) and 7 j(t) converge to zero exponentially fast. In other words, u > g (t) 
must at least change magnitude over some nontrivial interval over an interval of length T 2 * Equation 
(39) establishes the persistency of excitation (PE) condition for the combined scale factor and bias 
observer. 


Stability of Alignment Observer 


Choose a Lyapunov function as 

v (t) =- 1 ~ + ’feW - 0 

° U 2\(rj 0 (t)+l) 2 + i 0 (t) T i 0 (t) fj 0 (t) < 0 

, + ig(t) T i g (t) fj g (t)> 0 

2 \(Vg(t) + l) 2 + ig(t) T i g (t) rjg(t) < 0 


After manipulation, with the choices k{t) = 4||u? ff (t)|| + k' and ki(t) = 6||co 5 (t)|| + fc^, with any 
k' > 0 and k[ > 0, the derivative of V Q (t) is bounded as 


Vo(t) < -fc'||e-o(t)|| 2 - fclllfoWII < -fc'l|£ 0 WH 2 


(41) 


If u j g (t) is bounded, V Q {t) is a continuous, twice differentiable function. Barbalat’s lemma shows that 
\\i 0 (t)\\ — > 0 as t — > 00. 15 


The system given by (31) and (32) is stable. If us g (t) is bounded, all the signals are bounded. As with 
the gyro bias observer analysis, the system is cast as a linear time- varying system x(t) = A(£)x(t) 14 

where x(t) = ^ 


w 

(«) 


In this case, developing A(t) is more involved. The matrix A{t) is written as 


A(t) = 


An(t) A\2(t) 

A 21 (t) 0 


where 

A n {t) = Qi{qo{t))sign(rj 0 (t))[k + k x E\ 
A l2 (t) = - Q 1 (^(t))[(i?(^(0KW)^W T 

- (e p (0 T %(%W) i - 
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Mi(t) = - Q 1 (g 5 (0)[(/2(g 9 (t))w 9 (t))f o (<) r 

- (i 0 (tyR(q g (t))u g (t )) I - %(0S(Jl(9 ff (t)K(*))] 

where E is a diagonal matrix with the inverse of the absolute values of the components of i 0 (t) 
on the main diagonal, |s:(i) i |“ 1 . Again, the equilibrium point x(t) = 0 of this equivalent system is 
exponentially stable if the pair (A(t),C) is uniformly completely observable (UCO). Rewriting V Q (t) 
as V Q (t) < -x(t) T C T Cx(t) < 0, the matrix is C is defined as C — [y/jp I 0]. Examining the UCO 
properties, under output feedback, results in a persistency of excitation condition. Omitting the 
derivation details, if the following is true for a bounded u> p (£), for any z in R 3 

rt+T2 

z T [ j ((u;(r) r a;(r))I - u>(t)u>(t) t )(1t]z > 0 (42) 

the system is UCO. In order to estimate the alignment errors, the angular velocity must change 
directions. Over an interval of length T 2 , the angular velocity must not remain in a plane. If (42) is 
satisfied, the system is UCO, and the errors converge to zero exponentially fast. (42) establishes the 
persistency of excitation condition for the alignment observer. 


Stability of Combined Alignment and Bias Observers 


The Lyapunov function is the same as that given in (40) with the addition of ~b(t) T b(t). V Q (t) 
is the same as (41), establishing that the error signal b(t) is globally, uniformly bounded. If w g (t) is 
bounded, V Q (t) is a continuous, twice differentiable function with V 0 (t) bounded, given that u> g (t) is 
bounded. Barbalat’s lemma 15 shows that ||e r 0 (t)|| — ► 0 as t — ► oo. 


If u ) g (t) is bounded, all the signals are bounded. The system is again analyzed as x{t) = A(t)x(t ). 14 
Here A(t) is given as 


A(t) = 


An (t) Ai2(t) 
A 21 (t) 0 

§sign(f? 0 (t)) 0 


where the terms Aa(t) are defined above. C is now C = 
bounded u> g (t), for any z in R 3 


-\Qx{qo{t)) 1 

0 

0 

[y/JPl 0 0]. If the following is true for a 



B(tYB{t) 

~B(t) t 1 

Vt 

~B(t) 

J 


dr]z 


(43) 


the system is UCO, and both e c (t) and 7 j(t) converge to zero exponentially fast. The matrix B(t) is 
given as 

B{t) = {R(q g (t)) T u:(t))i g (t) T - (f 5 (t) T u;(t))I - rj g (t)S(R(q g (t)) T u>(t)) (44) 

R(q g (t)) and i g (t) both converge to constants (ideally to the identity matrix and zero, respectively). 
Analyzing the matrix in equation (43) is similar to the analysis for the alignment observer alone. The 
upper left diagonal matrix in (43) reduces to the same matrix as in (42). If u>(t) changes direction 
sufficiently over some nontrivial interval, over an interval of length T 2 , the matrices on the main 
diagonal of (43) will be positive definite, whereas the off diagonal matrices will evaluate to zero. (43) 
establishes the persistency of excitation (PE) condition for the combined alignment and bias observer. 


Stability of Combined Alignment, Scale Factor, and Bias Observers 


If the alignment, scale factor, and bias observers are all combined, the attitude error quaternion 
kinematic equation is 



Qi(q 0 (t)) 


(R(q g (t)) - I)-R(g 9 (<))Q ff (i)7/ - - b(t) 


- k(t)i 0 (t)siga{fj 0 (t)) - fci(t)sign(e 0 (t))sign(7? 0 (t))) 


(45) 
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The Lyapunov function is the same as the alignment observer with ~b(t) T b(t) and L yi(t) T ji(t ) added. 
V 0 (t) is also the same as for the alignment observer, with the addition of the term 7 j. If an a priori 
upper bound is known for 7 /, V 0 (t) is bounded as in (41). This establishes that b(t) and 7 /(t) are 
bounded. If ui g (t) is bounded, V Q (t ) is a continuous, twice differentiable function with V Q (t) bounded, 
given that w g (t) is bounded. Barbalat’s lemma 15 shows that ||e 0 (t)|| 0 as t — + 00 . 

If u> g (t) is bounded, all the signals are bounded. The system is again analyzed as x(t) = A(t)x(t). 14 
Here A(t) is given as 


Mt) = 


A n (t) 

A 21 (t) 

-fo g (t)R(q g (t)) T sign(rj 0 (t)) 

isign(^ 0 (t)) 


^12 W 

0 

0 

0 




0 

0 

0 


0 

0 


where 4n(() and A 2 \ (t) are defined for the alignment observer. A f 12 (t) is similar to Ai 2 (t) with 
i?(4 5 (^))^ p (i)7/ replacing R(q g (t))u* g (t). C is now C = [y/k'l 0 0 0]. Equivalently to the alignment 
observer, the UCO property is examined with output feedback, resulting in a persistency of excitation 
condition. If the following is true for a bounded for any z in R 3 (the time argument is omitted 

for clarity) 

*[f M(t)dr^z>0 (46) 


where 


B T B -\B T R{q g )R{q g ) r Sl g 

AO_Tl(aA'R(nA T n io P(n MWn \ T ^(n \ R(n 

-lR(qg)R(q g ) T n g 




-*2?* 

_IO Tt(n \R(n \ T R 

II 


and here 


B{t) = (R(q 9 )R(q 9 (t)) T H 9 (t) li)e g {t) T - (e fl (t)^(g 5 )iZ(g ff (t)) T ^(t) 7 /)I 
-fj 9 (t)S(R(q 9 )R(U)yn g (t) 7 /) 


Again, R(q g (t)) and i g (t) converge to constants. If the angular velocity, in addition to being bounded, 
satisfies the integral in equation (46) over an interval of length T 2 , the system UCO, and the errors 
b(t) 7 7 /(£), and i g {t) converge to zero exponentially fast. 


CLOSED LOOP STABILITY 


The nonlinear tracking control strategy proposed in Ref. 19 and summarized above cannot be 
implemented because exact measurements of the angular velocity w(t) are not available. Instead, a 
certainty equivalence approach is proposed using estimates u>(t) generated by the observer equations, 
resulting in 

u(t) = -K D s(t) + H& r (t) - S{H&(t))u r (t) (47) 

where s(t) = <2>{t) - uj r (t), u> c (t) = u>(t) - R(q c (t))u d (t), and 

a r (t) - R(q c (t))dj d (t) - S(u> e (t))R(q c (t))u>d(t) - XQi{q c (t))Cj c (t) 

Substitution of (47) into (12), the attitude dynamics, results in the following closed loop equation 18 

Hs(t) - S(ffu(t))s(t) + K D s(t) = A (q e (t),ofd(t))S(t) (48) 

where A(q c (t),u>d(t)) = -S(u> r (t))H-HS(R(q c (t))u>d(t))+\HQi(q c (t))+K D = A'(q c (t),Ud(t))+K D . 
A \q c (t),Ud(t)) is a bounded matrix over any solution of the coupled dynamics (19) or (22), (20) or 
(21) or (23), (12), and (47). 
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In the case of gyro bias, the error term s(t) is written as 

s(t) = u>(t) - u>{t) = —b(t) 
The closed loop dynamics are then written as 


Hs(t) - S(ffv(t))s(t) + K D s(t) = -A (q c (t), u> d (t))b(t) (49) 

The control law (47) results in global stability and asymptotically perfect tracking, ||e c (£)|| — 1 1 0, ll*c(*)|| - 
0. The proof is given in detail in Ref. 18. 


Closed Loop Stability with Constant Scale Factor Error 


Given the Lyapunov function V c (t) = s(t) T Hs(t ), the derivative of V c (t ), using (48), is 

V c (t) = - s(t) T K D s(t ) + s(t) T A(q c (t), u> d (t))(s(t) - s(t)) (50) 

Rewriting the error term 

s(t) - s(t) - u(t) - 6>{t) = T~ l <jj g {t) - f (£) 

~ T u; 9 (t) — r = Tj{t)u: g (t) (51) 

Since v g {t) = Tu(t) = T(s(t) ~\-cj r (t)) equation 51 is rewritten as 

s(t) - s(t) = frit) T(s(t) + (52) 

The convergence of s(t) to zero depends on the exponential convergence of the scale factor errors, 
which in turn depends on the angular velocity v g (t) generated by the applied control. The derivative 
of V c {t) is bounded as 


Vc{t) < -(% - (k D + C')7 n /7n/(f))||s(f)|| 2 + 


2 


2k L 


7n/(0 2 


(53) 


where k D is the smallest eigenvalue of K D , 


C' = sup sup ||A / (g c (t),o; d (t))|| < oo 

||qc(*)l!=l 

If the scale factors are known to be bounded within a positive region, with projection implemented 
in the observer such that the scale factor estimates remain with a bounded, positive region, 20 and k D 
is sufficiently large, the closed loop system is uniformly, ultimately bounded. If the angular velocity, 
uj g (t), in addition to being bounded (which ensures that the observer error terms are at least bounded), 
satisfies (38), the system is UCO and the scale factor errors converge to zero exponentially fast. In 
this case Theorem B.8 of Ref. 15 applies. V c (t) converges to zero exponentially fast, which means 
s(t) converges to zero exponentially fast, for any ko > 0 and without placing restrictions on the scale 
factors and the scale factor estimates. With the convergence of s(t) — > 0, the proof of convergence of 
the actual attitude and rate errors follows exactly as in the gyro bias analysis of Ref. 18. The end 
result of which is lim t _* 00 )|e c (£)|| = 0 and lim t _ 00 ||d> c (t)|| = 0. 


Closed Loop Stability with Constant Scale Factor and Bias Errors 

The Lyapunov function is the same as that above, with V c (t) given by (50). The error term is now 
s(t) - s(t ) = u(t) - u>(t) = r~ 1 uj g (t) -b- Ti{t)u g {t) + b(t ) 


= f - b(t) = n g (t)ji(t) - b(t) 


(54) 
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Since u> g (t) = T(a>(t) + b) (54) is 


s(t) - s(t) = f j(£)r (s(t) + cv r (t) 4- b) — 6(t) 


Finally, V'c(t) is bounded as 

V c (t) < - fc D ||s(0|| 2 + (k D + C')7n/(t)7n/||s(0|| 2 + (ho + C')7n/|K(0||||s(t)||7„/W 

+ (ko + C')7nj||b||||s(t)i|7„i(t) + (k B + C , )ll«(t)lll|b(t)|| (55) 

where k Dy and u> r (t) are defined above. Again, if the scale factors are known to be bounded within a 
positive region, with projection implemented in the observer such that the scale factor estimates remain 
within a bounded, positive region, 20 and k D is sufficiently large, the closed loop system is uniformly, 
ultimately bounded. If the angular velocity, u^(t), in addition to being bounded (which ensures that 
the observer error terms are at least bounded), satisfies (39), the system is UCO and the scale factor 
and bias errors converge to zero exponentially fast. As detailed above, the error s(t) converges to zero, 
resulting in convergence of the attitude and rate tracking errors. 


Closed Loop Stability with Constant Alignment Error 

Again, using the Lyapunov function V c {t) = ^ s(t) T Hs(t ), the derivative of V c (t) is 

V c (t) = -s{t) T K D s(t) + s(t) T A(q c (t), v d (t))s(t) (56) 

The error term s(t) is rewritten as 

s(t) - s(t) = «(t) - *(i) = cj(t) - R(q g (t))oj g (t) = (I — R(q g (t)rMt) 

Substituting u(t) = s(t) + u? r (t) from (16), s(t) is 

m = (I - R(q g (t)) T Mt) = (I - R(q g (t)) T )(s(t) + Ulr («)) (57) 


The convergence of s(t) to zero depends on the exponential convergence of the alignment errors, 
which in turn depends on the angular velocity u(t) generated by the applied control. The derivative 
of V c (t) is bounded as 


v c {t) < -(y - (k D + Ol|e« (0ll)ll«WII 2 + 


(fc 0 + C') 2 lK(t)H 2 

2 kr> 


,WII 2 


(58) 


If the alignment error is less than 90 degrees and k D is sufficiently large, the closed loop system is 
uniformly, ultimately bounded. If the angular velocity, u;(t), in addition to being bounded, satisfies 
(42), the system is UCO and the alignment errors, (£), converge to zero exponentially fast. As in the 
case of scale factor error, Theorem B.8 of Ref. 15 applies. V c (t) converges to zero exponentially fast, 
which means s(t) converges to zero exponentially fast, for any k&> 0 and any alignment error. With 
the convergence of s(t) —> 0, the proof of convergence of the actual attitude and rate errors follows 
exactly as in the gyro bias analysis of Ref. 18, lim^ 00 ||e c (£)|| = 0 and lim t _* 00 ||d> c (t)|| = 0. 


Closed Loop Stability with Constant Alignment and Bias Errors 

Again, using the Lyapunov function V c (t) — ^s(t) T Hs{t), the derivative of V c (t) is given in (56). 
The error term s(t) is 

s(t) - s(t) = R(q g (t))R(q g (t))u g (t) - b - R(q g (t))u> g (t) + b(t ) 

= (R(q g (t))-l)R(q g (t))u g (t)-b{t) 
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The angular velocity, u g (t), is written as 

Us W = %f(4) + 6) 

Substituting the expression for u>(t) = s(t) + u> r (£) into the expression for u J g (t) the error s(t) — s(t) 
becomes 

s(t) - s(t) = ( R(q g (t )) - I )R(q g (t))R(q g ) T (s{t) + <*.(*) + b) - b(t) 

The convergence of s(t) to zero depends on the exponential convergence of the alignment errors, 
which in turn depends on the angular velocity u >(£) generated by the applied control. The derivative 
of V c (t) can be bounded, again, after some manipulation, as 

Vc(t) < - M«(*)ll 2 + 2(kn + OIM*)IIH*)ll a 

+ (*p + OK«)lll|SWII (59) 

where k D and C axe defined above. If the alignment error angle is less than 90 degrees and k D is 
sufficiently large, the closed loop system is uniformly, ultimately bounded. If the angular velocity, 
u>(£), in addition to being bounded, satisfies (43), the system is UCO and the alignment and bias 
errors, i g (t ), converge to zero exponentially fast. Again, this ensures that s(t) converges to zero, for 
any k^ > 0 and any alignment error. With the convergence of s(t) — ► 0, the proof of convergence of 
the actual attitude and rate errors is the same as above. The end result of which is lim t -> 00 ||£ c (t)|| = 0 
and lim t _>oc ll*c(«)ll=0. 


OBSERVER SIMULATION RESULTS 

The observers are tested with a MATLAB© simulation. Table 1 lists the initial conditions for 
each observer, as well as the true states. The initial attitude quaternion and initial estimated attitude 
quaternion are the same for each observer test. First, results from the gyro bias observer are presented. 


Observer State 

Value 

True State 

Value 

q(to) 

[o,i,o,cr 

o) 

[0,0, 1,0]^ 

b(t 0 ) 

(0,0, or & 

m 

[2.9,— 2.9,1.9] T 4f§ 

7 (t) 

[1.1.1] 

7 

[3, -5,4] 

4g(t) 

[0,0,0, 1] 

9s 

[0,0, 1,0] 


Table 1 Observer Simulation Initial Conditions 


The scale factors and alignment are known (and, without loss of generality, are each set to identity). 
The gain is chosen as k = 1. The angular velocity is u j(t) = [—5.7, 11.4, —22.9] deg/sec. Figure 1(a) 
shows ||6(£)|| converges to zero exponentially. 

Next, results from the scale factor observer are presented. Here the gyro bias is zero, and the 
alignment matrix is the identity matrix. The angular velocity is the same as in the gyro bias observer 
tests with u>(t) T = [-5.7,11.4,-22.9] deg/sec, k = 5. Figure 1(b) shows that the scale factor errors, 
7/ — 7 i(t), converge to zero. (Note that the inverse of the scale factor errors are plotted. Only the 
inverse of the estimate is used in the observer.) 

Finally results from the alignment observer are presented. The gyro bias is zero, and the scale 
factor matrix is the identity matrix. The angular velocity is time varying. The angular velocity is 
uj(t) T = [coso; m t,sina; m t,cos2a; r7l t] deg/sec where u; m = 2 rad/sec. The gains are chosen as k' = 0.001 
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(a) Gyro Bias Error (b) Scale Factor Error 



Figure 1 Observer Errors Solving for Each Error Separately 


and k[ =0.1. This angular velocity meets the persistency of excitation condition of (42). Figure 1(c) 
shows that alignment errors converge to zero. 

The combined observers are tested next. First, the combined scale factor and bias observers are 
tested. The alignment matrix is the identity matrix. The angular velocity components are sinusoidal, 
c Ogiit) = sinatf, with a = 5.7 deg/sec, and k = 5. Figures 2(a) and 2(b) show that the bias and 
scale factor errors converge to zero. Next, the combined alignment and bias observers are tested. The 
angular velocity is chosen as u;(t) T = [cosu; m t, sinu; m t, cos2w m £] deg/sec, where u; m = 2 rad/sec. The 
gains are chosen as k' = 10, k[ = 0.1. Figures 2(c) and 2(d) show that the alignment errors and bias 
errors converge to zero. 


CLOSED LOOP SIMULATION RESULTS 


The combined observers and controllers are also tested with a MATLAB© simulation. The inertia 
matrix is a diagonal matrix with principal moments of inertia chosen arbitrarily as [90, 100,70] kgm 2 . 
The size of the principal moments of inertia is comparable to that of a small satellite. Table 2 lists 
the initial conditions for the observer and controller, as well as the true states. All the tests start with 
the same initial attitude quaternion, initial observer attitude quaternion, and initial desired attitude 
quaternion. The combined observer /controller is first tested with a gyro bias. The gains are chosen 
as k = 1, K d = k D I, k D = 6, and A = 3. The desired trajectory is to track a 6.3 deg/sec rotation 
about the y-axis. The initial angular velocity is u;(t 0 ) — [ — 5.7, 11.4, -22.9] T deg/sec. Figure 3(a) 
shows that ||6(t)|| converges exponentially to zero. Figure 3(b) shows the tracking error, ||e c (£)||, 
converges asymptotically to zero. Figure 3(c) similarly shows that the rate tracking errors converge 
to zero. Without correcting for the bias, the tracking error has a steady state error of approximately 
30 degrees, as shown in Figure 3(d). The coupled observer/controller is tested with a scale factor 
error. The gains are chosen as k — 1, K D — k D I 3 (where / 3 indicates a 3x3 identity matrix), k D = 20, 
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Figure 2 Combined Observer Errors 


Observer State 

Value 

True State 

Value 

q(to) 

[0,0,0, l] r 

q(t o) 

[o,i,o, or 

b(t 0 ) 

[0,0, 0]^ 

m 

[2.9, —2.9, 1.9] r 4ff 

7(0 

[1.1.1] 

7 

[3, -5, 4] 

9g(t) 

[0,0,0, l] r 

9s 

<ld{t o) 

[0,0, 0.3827, 0.9238] T 
[0,0,0,!]- 


Table 2 Closed Loop Simulation Initial Conditions 
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(c) Rate Tracking Error (d) Attitude Tracking Error Without Cor- 

recting for Bias 

Figure 3 Coupled Observer/ Controller With Gyro Bias 


and A = 0.1. Here the initial angular velocity is u>(0) r = [0,0,0], and the desired angular velocity 
is constant, u>d{t) T = [2.8, 2.8, 2.8] deg/sec. Figure 4(a) shows that the scale factor errors converge 
to zero. Figures 4(b) and 4(c) show that both the tracking attitude error and the tracking angular 
velocity error converge to zero. The controller is then run without correcting for the scale factor. 
Figure 4(d) shows the attitude tracking error, with the true scale factor reduced by a factor of 100 
(the scale factor given in Table 2 produced tracking errors considerably larger). Without correcting 
for the scale factor, the tracking errors do not converge. The coupled observer/controller is then 
tested with a .constant alignment error. The gains are chosen as k r ~ 0.1, k[ = 0.1, K D = k D I$ 
(where Is indicates a 3x3 identity matrix), k D — 20, and A = 3. The initial angular velocity is 
u;(0) T = [0,0,0]. The gyro coordinate frame is rotated by 45 degrees from the body frame, about 
the z-axis. The desired angular velocity changes direction, similarly to that used above to test just 
the observer, u^(t) T = 5.73[cos w m £,sinu; m £, sin 2uj m t] deg/sec, with = 1 deg/sec. Here, all the 
errors converge to zero. Figure 5(a) shows that the alignment errors converge to zero. Figures 5(b) 
and 5(c) show that that attitude and rate tracking errors converge to zero. Without correcting for 
the alignment, the attitude tracking error does not converge to zero, as shown in 5(d). Finally, the 
combined observers coupled with the nonlinear controller are tested. First the combined scale factor 
and bias observer /controller is tested. The gains are chosen as k = 5, K D = k D Is (where Is indicates 
a 3x3 identity matrix), k D = 10, and A = 3. Here the initial angular velocity is u;(0) T = [0,0,0], 
and the desired angular velocity is sinusoidal, u: d {t) T = [sin at, sin at, sin at] where a = 5 deg/sec. 
Figures 6(a) and 6(b) show that the scale factor and bias errors converge to zero. Figures 6(c) and 
6(d) show that both the tracking attitude error and the tracking angular velocity error converge to 
zero. The combined alignment and bias observer/controller is tested last. The gains are chosen as 
k f = 5, k[ = 0.1, K d — k D Is (where / 3 indicates a 3x3 identity matrix), k D = 20, and A = 3. The 
initial angular velocity is u>(0) T = [0,0,0]. Again, the gyro coordinate frame is rotated by 45 degrees 
from the body frame, about the z-axis. The desired angular velocity changes direction and is given as 
(jj d (t) T = 5.73[cosu; m t,sintt; m f, sin2u; m t] deg/sec, with <x; m = 2 rad/sec. Figures 7(a) and 7(b) show 
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(a) Scale Factor Inverse Error (b) Tracking Attitude Error 



(c) Tracking Rate Error (d) Tracking Attitude Error Without Cor- 

rect for Scale Factor 


Figure 4 Coupled Observer/ Controller with Scale Factor Error 


that the alignment and bias errors converge to zero. Figures 7(c) and 7(d) show that the attitude and 
rate tracking errors, respectively, converge to zero also. 


CONCLUSIONS 

Three nonlinear observers for estimation of gyro bias, scale factor error, and alignment error are 
presented. All the observers are stable. The bias observer is exponentially stable. Both the scale 
factor and alignment observers are exponentially stable, but only under the condition that the angular 
velocity is bounded and meets a persistency of excitation condition. The observers are combined into 
a scale factor/bias observer, an alignment /bias observer, and an alignment/scale factor/bias observer. 
The combined observers are stable, exponentially stable if necessary persistency of excitation conditions 
are met. 

The observers and combined observers are also coupled with a nonlinear control algorithm for 
attitude control of a rigid spacecraft. The coupled observer/controller in the case of bias error is stable. 
The tracking attitude and rate errors converge asymptotically to zero, and the bias errors converge 
exponentially to zero. The coupled observer/controller in the case of scale factor errors is stable, and 
converges asymptotically if the angular velocity is bounded and satisfies the pertinent persistency of 
excitation condition. The same is true for the coupled observer/ controller in the case of an alignment 
error, as well as the combined scale factor and bias observer /controller and the combined alignment 
and bias observer/controller. The closed loop systems are asymptotically stable if the angular velocity 
is bounded and meets the persistency of excitation condition for the each observer. Future work will 
examine the combined alignment /scale factor/bias observer in more detail. 


17 







recting for Alignment 

Figure 5 Coupled Observer/Controller with Alignment Error 
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